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TITLE 

SELF-CORRECTING WIRELESS INERTIAL NAVIGATION 
SYSTEM AND METHOD 

BACKGROUND OF THE INVENTION 

Field of the Invention 

[0001] The present invention relates to a self-correcting wireless inertial navigation system 
and to a method of self-correcting wireless inertial navigation and is useful in particular, but 
not exclusively, for local position measurement, which is useful for many different 
applications, for example computer input, docking, robotic programming, and other 
measurement tasks. 

Description of the Related Art 

[0002] The Global Positioning System (GPS) has revolutionized position sensing for large- 
scale outdoor systems, such as shipping and land navigation. However, GPS technology 
cannot be directly applied to small scale position measurement because clocks cannot count 
fast enough to time short duration light pulses. 

[0003] Ultrasonic systems imitating the Global Positioning System have been investigated, 
but suffer from inaccuracies caused by moving air currents, echoes and acoustic noise. One 
prior art local position sensing system employs magnetic sensors and emitters to detect 
position for motion capture, and is usually used in film gaming and virtual reality 
applications. 
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[0004] Other researchers have attempted to directly use phase information to track position. 
For example, one prior art system uses a coarse and a fine frequency measurement to 
determine the location of a transmitter as a function of wavelength. However, phase 
measurement alone cannot determine the world coordinates of a target. If the transmitter 
5 moves more than a single wavelength during a measurement iteration, the absolute position 

of the transmitter becomes uncertain. 
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[0005] Inertial navigation systems have been investigated for local position measurement. 
However, inertial systems suffer from integrator drift and must be compensated or calibrated 
1 0 using a secondary measurement system. 

[0006] In United States Patent No. 6,176,837, issued January 23rd, 2001 to Eric M. Foxlin, 
there is disclosed a tracking system and method for tracking the position of a body which 
employ two sensor systems to obtain two types of measurements associated with motion of 
1 5 the body, one comprising acoustic measurement. An estimate of the orientation and position 

of the body is updated, based on, for example, inertial measurement, and the estimate is then 
updated based on, for example, acoustic ranging. 

[0007] It has also been proposed to effect motion tracking by a combination of inertial, 
20 ultrasonic and geomagnetic sensors for use, in particular, in high-end virtual reality and 
military applications. 



BRIEF SUMMARY OF THE INVENTION 



25 [0008] According to the present invention, the position of a mobile unit is determined by 

inertial sensing of the position, by phase difference triangulation measurement of the 
position and by employing the phase difference triangulation measurement to correct the 
inertial sensing of the position. 
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[0009] Preferably, measurement of the position of a mobile unit by the inertial sensing is 
transmitted as an RF signal from the mobile unit to a base unit, and the RF signal is also 
employed for the phase difference triangulation measurement, which enables the present 
invention to be implemented in an elegant and inexpensive manner. 

[0010] Thus, phase information from the RF signal may be employed to correct the inertial 
position measurement for drift. The inertial sensing provides global position information, 
independent of a line of sight. The phase information from the phase difference 
triangulation measurement ensures that local error does not accumulate. 

[0011] When the communication system employed for transmitting and receiving the RF 
signal is also employed for the phase difference triangulation, the present system can be 
implemented in an elegant and inexpensive manner. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0012] The present invention will be more readily apparent from the following description 
of a preferred embodiment thereof given, by way of example, with reference to the 
accompanying drawings, in which: 

Figure 1 shows a block diagram of a self-correcting wireless inertial navigation system 
embodying the present invention; and 

Figure 2 shows a block diagram of parts of the system of Figure 1. 

DESCRIPTION OF THE PREFERRED EMBODIMENT 

[0013] In the accompanying drawings, there is shown a self-correcting wireless inertial 
navigation system which includes a base station 10 and a mobile unit 12. The mobile unit 
12 in includes an accelerometer 14, which in the present embodiment of the invention is in 



implemented as an ADXL202 two-axis accelerometer manufactured by Analog Devices Inc., 
a microcontroller 16, implemented as a PIC 16 F876-20 microcontroller manufactured by 
Microchip Corp., and a transmitter 18 in the form of a TXM-900-HP II receiver board 
having an antenna 20 for broadcasting a measurement signal in the form of an RF signal. 

[0014] The base station 10 has three antennas 22a, 22b and 22c for receiving the 
measurement signal. This antenna 22a is connected to an RF receiver 24, implemented as 
an RXM-900-HP-II receiver board on an MDEV-900-HP-II evaluation board manufactured 
by Linx Technologies Inc. The two antennas 22b and 22c are connected to an 
interferometer/phase detector 26 in the form of an AD8302 RF/IF Gain and Phase Detector 
manufactured by Analog Devices Inc. and the antenna 22a is also connected to the 
interferometer/phase detector 26. The receiver 24 and the interferometer/phase detector 26 
are connected to a PIC16F876-20 microcontroller 28, which outputs through a MAX233 
serial driver 3 0, manufactured by Maxim Integrated Products, to a Dell Optiflex GXPro Dual 
200MHz Pentium Pro personal computer 32. A monitor 34 is provided for displaying the 
output of the personal computer 32. 

[0015] In the operation of this system, the accelerometer 14, acting as an inertial sensor, 
provides a pulse width modulated inertial sensor output signal for each axis to the 
microcontroller 16, which supplies a corresponding frequency shift keyed signal to the 
transmitter 1 8 for broadcasting the inertial measurement data as the RF measurement signal 
from the antenna 20 of the mobile unit 12 to the antennas 22a-c of the base station 10. 

[0016] At the base station 1 0, the interferometer/phase detector 26 effects phase difference 
triangulation of the RF measurement signal from the antennas 22b and 22c and provides a 
corresponding output to the microcontroller 28. The inertial measurement data, through the 
antenna 22a and the receiver 24, is supplied directly to the microcontroller 28. 



[0017] The personal computer 32 is configured to employ the phase difference triangulation 
output from the interferometer/phase detector 26 to correct the inertial measurement and to 
output corresponding data to the monitor 34. 



[0018] The inertial measurement data is derived as follows: 

Acceleration measurements made by the accelerometer 14 are integrated twice to arrive at 
displacement. That is 



Ax = // xdt 



(1) 



[0019] To obtain distance traveled during a single sampling interval of the accelerometer 

system 



Ax = x,T 



(2) 



where 

Ax =x,r + x„ 7 ( 3 ) 

and T is the sampling interval. That is, the distance traveled during time period T is the 
average velocity during T, time T. 

[0020] The position from a known starting point x 0 is therefore 

x=Ji*x=x 0 ( 4 > 
j 

[0021] However, errors are also summed. Maximum error grows linearly with i as: 



the error at iteration i is equal to the number of iterations multiplied by the maximum inertial 
measurement error. The maximum error is an amalgamation of sensor error, signal 
conditioning error and digitizer resolution. Generally, the sensor error dominates, and the 
other two error sources can be ignored. 

[0022] Because very accurate measurements over extended time periods are required, 
sensor drift due to error accumulation is a primary concern. The sensor error is fixed by the 
component manufacturers, so error can only be controlled by altering z, the number of 
iterations between land marking operations. Because a reasonably high refresh rate, and 
continuation of operations for an extended period of time are required, i cannot implicitly 
be changed. However, by employing a secondary measurement system, we can maintain i 
= 1 . The maximum error from the accelerometer will then be 

e=max(e merlial 'e local ) ( 6 ) 

[0023] The error will be the greater of the inertial measurement error or the local 
measurement error. Because the inertial system is rezeroed at every iteration, i is fixed at 
1. 

[0024] The correction of the inertial measurement by phase difference triangulation 
measurement is effected in accordance with the following equations, which show the manner 
of calculating the position of the mobile unit 12 based on the two receiving antennas 22b and 
22c, both at a distance r from the origin. In the following calculation, X is the carrier 
wavelength, <f> is the measured phase angle, and d , and d 2 are the respective distances from 
the transmitter to each receiving antenna. 



d , = k X + m 
d 2 = jX + n 



d x - d 2 = (k - j)X + (m - n) 



+ 



m 



n 



\ 



X 



n 2 



[0025] The first plus/minus is required because we do not measure which wave is leading. 
The second plus/minus is required to correct the phase to correspond from 0 to 360 degrees, 
even though phase only measures from 0 to 90 degrees. 

[0026] From the estimated position of the transmitter, based on the inertial measurement: 




k = floor 



d 



X 
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d 2 
X 

V J 
m = d j - k X 
n = d 2 - j X 

[0027] The minimum distance to (m, n) on the line 

<j>X q 

m = n± ± — 

n 2 

along the perpendicular line 

m = (m + n) - n 

15 is given by:- 

(m + n) (f>X q 
n + _ — ± — 

2 2^-4 
[0028] Back substitution yields m. 



j = floor 




[0029] By substituting the measured m and n in for the estimated m, and n, the new 
distances are calculated. 



d , = kX + m 
d 2 = jA+n 

[0030] The actual position is determined using triangulation. 

(x + r) 2 + y 2 = dl 

(x - r) 2 + y 2 = d\ 
[0031] Which can be solved as: 



x = 



4r 



y 




[0032] The new measured position is given by (x, y), where y is chosen as the solution 
which lies in the positive half plane. 



